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L  INTRODUCTION. 

This  report  presents  two  great  circle  navigation  algorithms,  a  closest  point  of  approach 
(CPA)  algorithm  and  an  intercept  algorithm.  It  also  presents  an  implementation  program 
that  is  written  in  the  BASIC  language  for  an  IBM  PC.  Instead  of  using  classical  spherical 
geometry  or  the  general  spherical  triangle  [Ref.  1],  these  algorithms  incorporate  rectangular 
coordinates  and  vectors  on  the  surface  of  the  sphere.  Portions  of  the  vector  formalism  were 
suggested  by  Reference  2. 

The  intent  of  the  report  is  to  provide  algorithms  for  spherical  earth  models  that  can 
be  used  for  situations  in  which  flat  earth  models  are  not  appropriate,  but  that  do  not 
require  the  sophistication  of  rotating  earth  models. 

U.  RECTANGULAR  COORDINATES  AND  VECTORS  ON  A  SPHERE 


In  a  spherical  earth  model,  a  point  P  on  the  earth's  surface  can  be  located  by  a  position 
vector  p  =  xi+j(j-»-akma  rectangular  coordinate  system  with  origin  at  the  earth's  center. 
In  matrix  form,  and  with  z,  y  and  s  expressed  in  spherical  coordinates, 


P  = 


r  cos^cos  A 
r  cos  ^  sin  A 
rsin^ 


where  <p  is  the  latitude  and  A  is  the  longitude  at  the  point  and  r  is  the  distance  of  the 
point  from  the  earth’s  center.  See  Figure  1. 

In  terms  of  the  unit  vector  x  where 


’*r 

cos^cosA" 

X  = 

*i 

~ 

cos  4>  sin  A 

*k 

sin  ^ 

(i) 


p  s*  rx.  We  can  think  of  x  as  the  unit  vector  normal  to  the  surface  at  the  point.  It  is 
convenient  to  define  two  other  unit  vectors  in  the  tangent  plane  to  the  earth's  surface  at 
the  point.  These  are  local  north  n  and  local  east  s,  defined  by 


n  — 


Rf 


-ain^cos  A 
-sin^sinA 
cos  $ 


and 


e  = 


*A 


S5T 


sin  A 
cos  A 
0 


(2) 


where 


*♦  =  3? 


and 


9x 

XA-3X- 


The  vectors  x,  n  and  e  provide  the  basis  for  a  right-handed  orthogonal  coordinate  system. 
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Pifure  2.  The  Course  Vector 

Let  a  course  a  be  designated  at  a  point  on  the  earth’s  surface.  We  wish  to  determine 
the  unit  course  vector  e  in  the  direction  a  which  lies  in  the  tangent  plane  at  the  point 
in  terms  of  A  and  a  (see  Fig.  2).  An  arbitrary  vector  a,  defined  at  the  point  P  with 
coordinates  (r,  A,  <f>)  and  lying  in  the  tangent  plane  at  the  point,  can  be  rotated  clockwise 
(looking  from  P  toward  the  origin)  through  an  angle  a  by  using  the  operation  Rp(a)a, 
where  Rp(or)  is  the  rotation  operator.  Rj,(a)  is  a  composite  rotation  in  3- space  and  can  be 
decomposed  into  fundamental  rotations  in  one  of  several  ways.  One  way  is  to  proceed  as 
follows:  First,  move  P  (carrying  a  with  P)  along  its  parallel  of  latitude  to  the  x~x  plane  (the 
Greenwich  meridian);  this  is  equivalent  to  a  clockwise  rotation  about  the  s-axis  through 
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an  angle  A  and  is  denoted  by  R«(A).  Next,  move  P  along  the  Greenwich  meridian  to 
the  equator:  thi*  is  equivalent  to  a  counterclockwise  rotation  about  the  jf-axi*  through  an 
angle  $  and  is  denoted  by  Rf(~^).  The  point  P  now  liee  on  the  x-axia  with  coordinates 
(r,0, 0)  and  the  vector  a  at  P  makes  the  same  angle  with  the  Greenwich  meridian  as  it  did 
with  respect  to  the  original  meridian  at  (r,  A,  $.  Next,  leave  P  on  the  Greenwich  meridian 
at  the  equator  and  rotate  a  through  an  angle  a  about  the  x-axis;  this  clockwise  rotation 
is  denoted  by  R*(a).  The  vector  a  has  now  been  rotated  through  the  desired  angle  a 
with  respect  to  the  Greenwich  meridian.  When  P  is  returned  to  its  original  portion  by 
reversing  the  steps  which  got  it  to  the  equator  on  the  Greenwich  meridian,  it  will  have 
been  rotated  through  the  angle  a  with  respect  to  the  original  meridian  of  P ,  i.e.  R,(<£) 
followed  by  R,(  -A).  The  composite  rotation  operator  Rp(a)  is 

H,(a)  =  R*(-A)Rf(^)R«(a)R#(-^)R»(A). 


The  course  vector  can  then  be  written  as  c  =  Rp(a)n.  The  fundamental  x-,  y-  and  x-axis 
rotation  operators  are  given  by 


R-(#)  = 


1 

0 

0 


0  0  ‘ 
cos 6  sin# 
-sin#  cos# 


0 

1 

0 


*.(»)  - 


coed  sin#  0 

-sin#  cos#  0 
0  0  1 


and 


These  rotation  operators  are  consistent  with  a  right-handed  coordinate  system  and  positive 
signs  of  #  for  a  counterclockwise  rotation  of  the  coordinate  system  or  a  clockwise  rotation 
of  a  point  P  about  the  x-,  y-  or  z-axes,  respectively,  as  viewed  looking  toward  the  origin 
from  the  positive  end  of  the  rotation  axis  [Ref.  3,  pg.  43  and  Ret  4,  pg.  100].  Some 
amplification  in  determining  Rp(a)n  can  be  obtained  by  noting  that 


R,(-*)R,(A)n  = 


Thus  c  can  be  found  from 

c  -  R,(-A)R,(*)Ra(a)k. 


(3) 
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If  an  object’s  course  vector  e  is  known  at  some  point  with  position  vector  p  then  it  is 
easily  shown  (see  Fig.  S)  that 

n  •  c  ss  cos  a  and 


e  •  c  =  sm  a. 

From  these  relations,  the  course  a  is  found  to  be 


a  =  qatn(e  ■  e,n  ■  c)  (4) 

where  qatn  is  a  quadrant  determining  arctangent  function  (see  Appendix  A  and  Ref.  5). 


Figure  S.  An  Object's  Course 

The  coarse  can  also  be  determined  from  the  great  circle  vector  g  that  is  defined  by 

g  =  x  x  c,  (5) 

where  p  =  rx.  From  Figure  3  we  see  that  the  following  relationships  hold: 

n  •  g  =  cos  £  =  sin  a  and 
eg  —  cos  rj  =  ~  cos  a1 

whence 

a  -  qatn(a  g,  -«  g)  (6) 

If  the  object  is  traveling  with  speed  v  and  is  not  maneuvering,  it’s  course  will  be  a 


great  circle.  Let  vo  =  vco  denote  the  object’s  velocity  vector,  where  Co  is  its  course  and 
po  is  its  position  vector  at  time  0.  At  some  subsequent  time  t,  the  object’s  position  vector 
will  be  p (t)  and 

p(0  =  ap0  +  brQt  (7) 


where  a  and  6  are  to  be  determined  (see  Fig.  4).  Dotting  Equ.  7  from  the  right  by  po,  we 
see  that 

p(t)  ■  po  ~  opo  •  po 


or,  with  angles  in  radians, 

or 

a  —  cos  \  • 

Similarly,  dotting  Equ.  7  from  the  right  by  vo  we  find 

p (f)  •  t0  =  brQ  •  Tot  = 


or 

»=PjP(0-TO  =  ^ 

so  that 

.  f  ’ 

6  =  —  sm 

Vi 

Thus, 

...  fvt\ 

p(i)=pocos^  +T0~ain^ 
In  terms  of  the  unit  vectors,  this  equation  becomes 


rx(t)  -  n to  cos  +  t?eo 


r  .  fvt\ 
-  sin  (  —  ) 
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or 


x(t)  -  Xo  co«  (  —  j  +  Co  sin 


(£)+c09in(f) 


(8) 


Applications  of  the  these  relations  are  made  in  the  following  sections  of  this  report. 


m.  GREAT  CIRCLE  NAVIGATION. 

The  "Direct  Solution  Algorithm*  computes  the  latitude  and  longitude  of  a  position  Pa 
and  the  backward  asimuth  from  Pa  to  Pi  given  the  latitude  and  longitude  of  a  position 
Pi,  the  forward  asimuth  from  Pi  to  Pa  and  the  dirtance  from  Pi  to  P3.  The  “Inverse 
Solution  Algorithm*  computes  the  distance  from  position  Pi  to  position  Pa,  the  forward 
asimuth  from  Pi  to  P3,  and  the  backward  asimuth  from  Pa  to  Pi  given  the  latitude  and 
longitude  of  positions  Pi  and  Pa-  Details  of  these  algorithms  using  the  concept  of  the 
general  spherical  triangle  are  presented  in  Reference  5.  These  models  are  redeveloped  here 
using  the  concepts  of  Section  II. 

A.  The  Direct  Solution  Algorithm.  Given  Pi(^i,Ai),  forward  asimuth  (bearing)  aria 
and  distance  d,  find  ^3  and  A3  of  Pa  and  the  backward  asimuth  orai.  Proceed  as  follows: 

1.  Prom  <f>  1  and  Ai,  compute  the  components  of  Xi  using  Equ.  1. 

2.  Compute  ci  from 

ci  =R.(-Ai)R,(*i)R,(aia)k. 


3.  Compute  X3  using 


xa  =  xi  cos 


+  ci  sin 


Note,  with  d  =  vt  in  nautical  miles  and  r  -  60(180°/*-),  Equ.  8  becomes 


xJ=xlco.(A)+clSm(A), 

where  the  arguments  of  the  cosine  and  sine  are  now  in  degrees. 

4.  Prom  the  components  of  xj  compute 

=  sin-l(*ka)  and 

Aa  =  qatn(ija,iia)- 


5.  Compute  g  =  Xi  xcj. 

6.  Compute  n3  and  ®a  using  Equ.  2. 

7.  Using  Equ.  6  compute  Q31  -  -  qatn(»a  •  g,  -«a  *  g).  Note  that  the  sign  change  occurs 
because  a3i  b  the  backward  asimuth. 
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B.  Tie  Inverse  Solution  Algorithm.  Given  Pi  (<^i ,  Ai)  and  P<i{<h>  As),  find  the  distance 
d  from  Pi  to  P%,  the  forward  asimuth  a  12  from  Pi  to  Pa  and  the  backward  asiu  th  aai 
from  Pa  to  Pi .  Proceed  as  follows: 

1.  From  fa  and  A*  compute  x,-,  for  *  =  1, 2. 

2.  Compute  d  =  rco*"1^  -xa),  whence  d  =  60(180/r)  cos-1(xi  X3)  is  the  distance  in 
nautical  miles. 

3.  Compute  n,  and  «,•  for  i  -  1,2  (see  Equ.  2). 

4.  Compute 

S  = 

This  equation  arises  because  the  great  circle  passes  through  both  Xi  and  Xa,  hence  g 
must  be  perpendicular  to  xi  and  to  xa- 
6.  Compute  an  =  qatn(ni  •  g,  -«i  •  g). 

6.  Compute  aai  =  -  qatn(na  •  g,  -ea  *  g). 


*1  x  xa 
Ixi  x  xaT 


IV.  CLOSEST  POINT  OP  APPROACH  (CPA)  PROBLEM. 

Consider  two  objects  traveling  on  different  great  circle  paths.  From  Equ.  8,  their  tracks 
will  be  characterised  by  the  equations 


x,  (f)  =  x,o  cos  u +  c,o  sin  w,f ,  for  t  =  1, 2,  (9) 

where  a/,-  =  v,-/r.  At  any  time  f,  their  angular  separation  a(f)  in  radians  is  determined  by 

cosa(t)  =  Xi(t)xa(t).  (10) 


The  time  of  minimum  separation  (CPA)  is  that  time  T  when  J|[cos«(f)]  =  0.  That 
is,  we  must  find  T  such  that 


Unfortunately,  this  equation  cannot  be  solved  explicitly.  One  approach  is  to  use  the 
Newton- Raphson  iteration  method  (Ref.  6]  to  find  the  root  T  of  /(f),  where 


/«=*.«  •  nr* +  ^  •*»(*)• 


Taking  the  required  derivatives  of  Equ.  9  and  performing  the  required  dot  products,  we 
find  that 


/(f)  =  Asinu/i*  sinwaf  +  Bcoau/\t  cosu^f  +  C  sin  Wi  f  cos  w^f  +  JPcoswjf  sinu^f, 
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where 


A  =  —  (uixio  •  cao  +  W3X20  j  cio), 

3  —  W1C10  •  X20  4-  w 2C20  •  *10) 

C  —  —(wiXio  •  X20  —  U/3C30  •  Cio)  and 

D  —  <*>|Cio  •  C20  —  W2X2 0  •  Xio* 

The  use  of  the  Newton- Raphson  method  requires  that  the  derivative  of  /(f)  with  respect 
to  t,  namely  /'(f),  be  computed  or  estimated.  We  find  that 

f{t)  —  —  (Cui?  +  i?wi)sinwiiamwq$-l-(I?W3  +Cwi)coewitco8Wa< 

+  (Aui  -5wi)  sin  cos  Wat  -  (Bwa  -  Awi)coswitsinwat. 

The  Newton- Raphson  method  requires  us  to  compute 

=  fori  =0,1,...  (11) 

where  to  is  an  initial  estimate  of  T,  until  some  value  of  i  is  found  for  which  f(U)/f{U)  is 
sufficiently  close  to  aero. 

The  CPA  option  in  the  computer  program  (Appendix  B)  will  print  out  the  time  to 
CPA  (from  time  t  =  0),  the  distance  between  objects  at  CPA  and  the  bearing  from  object 
1  from  object  2  at  CPA.  Also  printed  is  the  number  of  iterations  required  for  convergence 
of  Equ.  11  to  |/(*»)//,(*i) |  less  than  0.00001  hours.  A  negative  time  to  CPA  indicates  that 
CPA  has  already  occurred. 

Y.  INTERCEPT  PROBLEM. 

The  intercept  problem  is  divided  into  two  problems,  each  of  which  may  require  an  answer. 
In  both  problems  we  are  given  the  initial  position,  course  and  speed  of  a  target  as  well 
as  the  position  of  an  interceptor  or  launch  platform.  In  the  first  problem  we  are  given 
the  time  (or  elapsed  time)  at  which  intercept  is  desired  and  ire  required  to  compute  the 
vehicle  speed  needed  for  an  intercept  to  take  place.  In  the  second  problem  we  are  given 
the  speed  of  an  Intercept  vehicle  and  wish  to  compute  the  time  required  for  an  intercept 
to  occur  provided  an  intercept  can  be  made.  Provision  for  both  of  these  options  is  made 
in  the  program  presented  in  Appendix  B. 

A.  Speed  Required  to  Intercept.  Inputs  are  the  initial  latitude  and  longitude  of  an 
interceptor  and  a  target,  and  the  target  course  and  speed.  Also  input  is  the  time  of 
the  desired  intercept.  Outputs  are  the  speed  required  of  the  interceptor,  the  course  of 
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the  interceptor,  the  distance  traveled  to  intercept,  and  the  latitude  and  longitude  of  the 
intercept. 

From  the  inputs,  use  Equ.  1  to  compute  xio  and  xao*  the  position  vectors  of  the 
interceptor  and  target,  respectively,  at  time  t  =  0.  Denote  the  time  required  to  intercept 
by  t.  Compute  the  target  course  vector,  eao,  using  Equ.  3  and  then  compute  xa(t),  the 
position  of  the  target  at  the  time  of  intercept,  using  Equ.  8.  The  remainder  of  the  problem 
is  solved  using  the  inverse  solution  algorithm  discussed  previously.  The  speed  required  for 
intercept  is  given  by  V|  =  d/t,  where  d  is  the  distance  from  the  initial  interceptor  position 
to  the  target  position  at  the  time  of  intercept. 

B.  Time  Required  to  Intercept.  Inputs  are  the  initial  latitude  and  longitude  of  an 
interceptor  and  a  target,  and  the  target  course  and  speed.  For  a  given  interceptor  speed, 
it  may  or  may  not  be  possible  to  make  an  intercept.  We  develop  two  sub-algorithms.  The 
first  algorithm  is  tr>  compute  the  minimum  interceptor  speed  required  to  achieve  intercept 
and  the  time  required  to  make  such  an  intercept.  The  second  algorithm  queries  the  user  to 
input  an  interceptor  speed.  If  the  speed  is  at  least  that  required  for  intercept,  then  the  time 
required  to  intercept  is  computed.  (If  the  interceptor  speed  is  greater  than  the  minimum 
required,  there  are  two  possible  solutions  for  the  time  to  intercept — the  shortest  time  to 
intercept  is  computed  by  the  algorithm).  Outputs  are  the  minimum  required  interceptor 
speed,  the  time  to  intercept  at  minimum  speed,  the  course  of  the  interceptor,  the  distance 
traveled  to  intercept,  and  the  latitude  and  longitude  of  the  intercept. 

Thu  first  problem  is  to  determine  the  minimum  speed,  vm,  required  to  make  an  in¬ 
terception.  This  can  be  accomplished  by  finding  the  time  of  intercept  tm  which  makes 
dv/dt  =  0.  We  can  relate  v  to  ?,  the  angular  separation  h  radians,  between  the  two  points 
Xio  and  xa(t)  by  the  relation  v(t)  =  rs(t)/t.  We  find  that  dv(t)/dt  -  0  implies 


r 


1  da  s' 
*  ■ 


=  0. 


(12) 


Anticipating  that  it  will  not  be  possible  to  find  a  dosed  form  solution,  we  prepare  to  use  the 
Newton- Raphson  procedure  (Equ.  11).  Multiplying  Equ.  (1.2)  by  t7  gives  us  the  function 


m = * 


da 

H 


-  a 


for  which  we  wish  to  find  tm  such  that  f{tm)  ~  0.  Also  needed  is 


pi  ii 1'S  'M'J'.i'V  r'Jf'-  V  .“  '•j  -;*  ~ui  -.*  to  ■  \ftv"  rjp  . 


Using  Equ.  10  to  determine  s(t)  we  find  that 


is 

dt 

d2a 


1  dx«{t) 

'“T’XlO 


sin  a 
1 

sins 


dt 


COBS 


sin  s 


(*io 


and 


a  ) 


+  3S10 


dhci(t) 


di2 


where 


*io  • 


d*a(*) 

dt 


u»a  (xio  •  X30  sin  Wat  ~  Xio  •  C20  cosw3i] 


and 


Xio  •  =  -^2  [*io  •  xao  cos  w^f  +  Xio  •  C30  sinwaij . 

The  Newton- Raphson  procedure  continues  until  tm  is  found,  then  vm  =  sr/tm. 

The  second  problem  is  to  find  the  time  of  interception  t/  when  the  interceptor’s  speed 
Vt  is  given.  Once  more  the  Newton-Raphson  procedure  is  used.  As  before,  we  can  relate 
vi  to  s(t)}  the  angular  separation  in  radians,  between  two  points  xio  and  xa(f)  by  the 
relation  v(t)  =  ra(t)/t ,  which  tells  us  that  we  must  require  wi  =  s(t)/t.  That  is,  we  wish 
to  find  t/  for  which  «(</)/</  equals  the  constant  wi,  or  equivalently,  we  wish  to  find  f/  such 
that  f(tj)  =  0  where 

/(<)  =  *-"  1. 


Also  needed  is 


The  equation  for  ds/dt  is  the  same  as  that  given  in  the  previous  paragraph.  The  remaining 
output  is  found  using  the  inverse  solution  algorithm  for  the  points  xio  and  X;}(f/). 


VI.  SAMPLE  PROBLEMS 

Master  Main.  The  master  menu  for  algorithm  demonstration  program  is  shown  below. 


ALGORITHM  DEMO 

1)  DIRECT  SOLUTION 

2)  INVERSE  SOLUTION 

3)  FIND  CPA 

4)  SPEED  NEEDED  TO  INTERCEPT 

5)  TIME  NEEDED  TO  INTERCEPT 

6)  QUIT 


Problem  1.  Suppose  you  are  at  San  Francisco  (latitude  37°  47'  north  and  longitude 
122® 25'  west),  that  your  initial  course  is  260°  and  that  you  travel  a  distance  of  4000  n.  mi. 
What  is  your  final  position?  Select  Option  1  from  the  master  menu. 

DIRECT  SOLUTION 

1st  LATITUDE  DD.MMSS  (-S)  7  37.47 
1st  LONGITUDE  DDD.MMSS  (-E)  7  122.26 
INITIAL  COURSE  DDD.MMSS  7  260 
DISTANCE  (n.  sd.)  7  4000 

SPHERICAL  EARTH  DIRECT  SOLUTION 
2nd  LATITUDE  6°41.9' 

2nd  LONGITUDE  -172^00.7' 

BACK  AZIMUTH  51°36.9' 

PRESS  ANT  KEY  TO  CONTINUE 
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Problem  2.  Suppose  you  are  at  San  Francisco  (latitude  37°  47'  north  and  longitude 
122° 25'  west)  and  that  your  destination  is  Sydney,  Australia  (latitude  33°51'  south  and 
longitude  151°  13'  east).  How  far  do  you  travel,  what  is  your  initial  course,  and  what  is  the 
backward  asimuth  from  Sydney  to  San  Francisco?  Select  Option  2  from  the  master  menu. 

INVERSE  SOLUTION 

1st  LATITUDE  DD.MMSS  (-8)  7  37.47 
1st  LONGITUDE  DDD.MMSS  (-E)  7  122.25 
2nd  LATITUDE  DD.MMSS  (-S)  7  -33.61 
2nd  LONGITUDE  DDD.MMSS  (-E)  7  -161.13 

SPHERICAL  INVERSE  SOLUTION 

DISTANCE  6446.3  n.ai. 

FORWARD  COURSE  240°18.9' 

BACK  COURSE  66°45,9' 


PRESS  ANT  KEY  TO  CONTINUE 


Problem  3.  Suppose  an  observer  is  at  20*  north,  60°  west  traveling  on  a  course  of 
010°  at  a  speed  of  IS  knots.  A  target  is  reported  to  be  at  34°  north,  50°  west  on  a  course 
of  220°  at  a  speed  of  300  knots.  Assuming  that  neither  observer  or  target  changes  course 
or  speed,  how  much  time  will  elapse  until  CPA  and  at  CPA  where  will  the  target  be  with 
respect  to  the  observer?  Select  Option  3  from  the  master  menu. 

FIND  CPA 

1st  LATITUDE  DD.MMS8  (-8)  ?  20 
1st  LONGITUDE  DDD.MX88  (-E)  ?  ftO 
INITIAL  COURSE  DDD.MKSS  ?  10 
SPEED  (knots)  ?  16 

2nd  LATITUDE  DD.MM88  (-8)  ?  94 
2nd  LONGITUDE  DDD.MKSS  (-E)  ?  50 
INITIAL  COURSE  DDD.XM88  ?  220 
SPEED  (knots)  ?  300 

TIME  TO  CPA  -  3hQ9s48s 
DISTANCE  AT  CPA  -  67.03  n.*i. 

BEARING  AT  CPA  -  304° 06. 3' 

NO.  ITERATIONS  -  3 


PRESS  ANT  KEY  TO  CONTINUE 


Am  an  additional  output,  a  table  of  observer  positions  and  target  positions  is  given  at 
CPA  and  six  equally  spaced  times  before  and  after  CPA. 

FIND  CPA 


TIME 

LAT  1 

LONG  1 

DISTANCE 

BEARXNG(i'>2) 

00a 

20*00.0' 

eo^o.o1 

994.34 

30*18.8' 

31b38u 

20*07.8' 

59°  58. 5' 

829.46 

29*31.6' 

IhOSalOa 

20*16.8' 

59°  57.1' 

684.78 

28*21.8' 

U34b54« 

20*23.4' 

59°  56. 8' 

600.56 

26*26.3' 

2A06b32s 

20*31.2' 

69°  64.1' 

337.43 

22*39.8' 

2b38Kl0a 

20*38.9' 

59*62.7' 

178.42 

12*02.7' 

3h09n48s 

20*48.7' 

69*51.2' 

67.03 

304*08.3' 

3h41«27s 

20*54.5' 

69*49.7' 

178.43 

236*10.0' 

4hl3a06a 

21*02.3' 

69*48.2' 

337.43 

226*33.2' 

4h44a43fi 

21*10.1' 

69*48.7' 

600.68 

221*47.3' 

6hl6a21s 

21*17.9' 

69*46.3' 

664. dl 

219*52.7' 

6M7«69a 

21*26.7' 

69*43.8' 

829.6 

218*43.7' 

6hi9*37e 

21°33.4/ 

69*42.3' 

994.41 

217*67.6' 

PRESS  ANY  KEY  TO  CONTINUE 
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Problem  4*  Suppose  an  observer  at  20°  north,  60°  west  wishes  to  launch  an  inter¬ 
ceptor  at  a  target  reported  to  be  at  34°  north,  50°  west  on  a  course  of  220“  at  a  speed  of 
000  knots.  If  interception  is  required  to  take  place  45  minutes  (2700  seconds)  after  launch, 
how  fast  must  the  interceptor  travel,  and  where  will  the  intercept  take  place?  (Assume 
that  the  target  does  not  change  course  or  speed.)  Select  Option  4  from  the  master  menu. 

SPEED  NEEDED  TO  INTERCEPT  (l->2) 

1st  LATITUDE  DD.MMS8  (~S)  7  20 

1st  LONGITUDE  DDD.MM8S  (-E)  7  60 

2nd  LATITUDE  DD.MMSS  (-S)  7  34 

2nd  LONGITUDE  DDD.MMS8  (-E)  7  60 

2nd  COURSE  DDD.NNSS  7  220 

2nd  SPEED  (knots)  7  600 


TIKE  TO  INTERCEPT  (SECONDS)  7  2700 


SPEED  REQUIRED 
BEARING  TO  INTERCEPT 
RANGE  TO  INTERCEPT 
LATITUDE  OF  INTERCEPT 
LONGITUDE  OF  INTERCEPT 


730.1  knots 
26*06.9' 
547.5  n.ni. 
28°08.0' 
55°27.6' 


1)  CHANGE  TI»  OF  INTERCEPT 

2)  NEW  PROBLEM 

3)  MASTER  MENU 
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Problem  S.  As  in  the  previous  problem,  suppose  an  observer  at  20°  north,  60°  west 
wishes  to  launch  an  interceptor  at  a  target  reported  to  be  at  34°  north,  50°  west  on  a 
course  of  220°  at  a  speed  of  600  knots.  If  the  maximum  speed  of  the  interceptor  is  700 
knots,  how  long  will  it  take  before  interception  can  occur,  what  should  be  the  interceptor’s 
initial  great  circle  heading,  and  where  will  the  intercept  take  place?  (Assume  that  the 
target  does  not  change  course  or  speed.)  Select  Option  5  from  the  master  menu. 


TIME  NEEDED  TO  INTERCEPT  (i->2) 

1st  LATITUDE  DD.HMSS  (-S)  ?  20 
1st  LONGITUDE  DDD.MMSS  (-E)  ?  60 
2nd  LATITUDE  DD.MMSS  (-S)  ?  34 
2nd  LONGITUDE  DDD.MMS8  (-E)  7  50 
2nd  COURSE  DDD.MMSS  ?  220 
2nd  SPEED  (knots)  ?  600 

MINIMUM  SPEED  REQUIRED  TO  INTERCEPT  -  52.6  knots 
TIME  REQ'D  TO  INTERCEPT  AT  MIN  SPEED  -  lh39aS0s 

INTERCEPTOR  SPEED  (knots)  ?  700 


TIME  REQUIRED 
BEARING  TO  INTERCEPT 
RANGE  TO  INTERCEPT 
LATITUDE  OF  INTERCEPT 
LONGITUDE  OF  INTERCEPT 


-  46b03s 

-  26*56 . 1' 

-  537.2  n.ffli. 

-  27*59.6' 

-  55*34. 7' 


1)  CHANGE  INTERCEPTOR  SPEED 

2)  NEW  PROBLEM 

3)  MASTER  MENU 
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APPENDIX  A:  The  QATN  Function 

This  routine  is  the  standard  arctangent  function  corrected  for  quadrant.  The  quadrant  arc¬ 
tangent  function  is  occasionally  implemented  as  the  ATAN3  function,  the  ANGLE  function 
or  the  Rectangular-to-Polar  function. 

Entering  variables  are  the  as-  and  y-coordinates,  X  and  Y .  The  exiting  variable  is 
the  angle  0,  where  -*  <  0  <  x.  Use  of  the  quadrant  arctangent  function  is  denoted  by 
0  =  qatn(F,X). 

1.  If  X  ^  0,  go  to  step  4. 

2.  Set  8  =  (sr/2)  *  sgn(F). 

3.  Go  to  step  8. 

4.  Set  0  =  arctan(Y/X). 

5.  If  X  >  0,  go  to  step  8. 

6.  Set  8  =  0  +  *■  *  sgn(Y). 

7.  If  Y  =  G,  set  0  =  w. 

8.  Return. 

Note: 

If  Y  >  0  then  sgn(Y)  =  +1. 

If  Y  =  0  then  sgn(Y)  =  0. 

If  Y  <  0  then  sgn(Y)  =  -1. 

Users  of  Microsoft  BASIC  can  simplfy  the  qatn  function  significantly  by  using  the  code 
given  below.  To  return  an  angle  of  0  (designated  by  A  in  the  code)  in  the  range  of  (-*,  *■), 
use: 

PI  -  4*ATN(1) :  TP  -  PI  +  PI:  EPS  -  IE-33 
A  -  ATN (T/ (X— EPS* (X«0) ) )  -  PI*(X<0)*(SCN(Y)  -  (Y-0)) 

To  return  a  value  of  A  in  the  range  of  (0, 2**),  use: 

PI  -  4*ATN(1) :  TP  -  PI  +  PI:  EPS  -  IE-33 
A  -  ATN (Y/  (X— EPS*  (X»0) ) )  -  PI*(X<0)  +  TP*(X  >=  0)*(Y<0) 
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APPENDIX  B:  Program  Listing 


10  *  “RECT  COORD  ALGORITHMS"  S.H.  SHUPDE,  03-03-86.  RE?.  03-19-88  1000 
13  *  RECTALOR-.A 
100  DEFCBL  A- £ 

110  PI4-ATN(li) : PI2-PI4+PI4 : PI-PI2+PI2 : TP-PI+PI : RD-PI/ 180# : EP8-1D-33 
120  AE-60#*360#/TP 

130  DIP  FNM(X)"I-5IC*INT(X/M0) : '  X  MOD  M  FUNCTION. 

140  DIF  FWL(X)-X-TP*INT({X+P2)/TP) : *  LONGITUDE  ADJUST  (-PI.PI) 

150  DIP  FMR(X)-IN7(X*Mi>+.S)/M0:  *  ROUNDINO  FUNCTION. 

160  DEP  FffO(X)“X+PI*8QI(X)*(ABSCX)>PI25  :  *  LATITUDE  ADJUST  (-PI/2, PI/2) 

170  DEP  FMACS(X)"ATN{SQR(1#-X+X)/(X-EPS*(XK>6)))-PI*(X<0#} : '  ARCCOS 
180  DEP  FNASM(X)“ATN(X/(SQR(l#-X*X)-EPS*(AB8(X)"i#))) : '  ARCS IN 
190  "QATN  (-PI.PI)  FUNCTION: 

200  DEP  FNATH2(Y, X)-ATN (T/(X-EP8*  (X*©#)  )  )  -PI*  (X<0i)  *  (3GN(Y)  - (Y*0#)  ) 

210  ‘QATN  (O.TVOPI)  FUNCTION: 

220  DEP  FNATNPCY,X)-ATN(Y/(X-EPS*(X-0i)))-PI*CX<0#)+TP*(X>-0#)*(Y<0i) 

230  ‘CROSS  PRODUCT:  Z(.)-X1(.)  X  X2(.): 

240  DEP  FNCX(X1JY1.21.X2.Y2,Z2)'-Y1*Z2-Z1*Y2 
250  DEP  FNCY(Xl.Yl,Zl,X2,Y2fZ25-X2*Zl-Z2*Xl 
260  DEP  PNCZ(Xl,Yl.Zl.X2,Y2,Z2)«Xi*Y2-Yl*X2 
270  GOTO  2000 
260  * 

1000  *  DECIMAL  TO  BH  MM  SS 

1010  V|"-  -:IF  X<0  THEN  V|— --:X— X 

1020  X-X+l/7200i:Y-INT(X):Z»LEH(8TRS(Y))-i 

1030  EX-0: IF  YoO  THEN  Y$«Vt+RiaiTS<-  •♦STRICT)  ,Z)+“li-:KX-l 

1040  X"60i* (X-Y) : Y"INT (X) 

1050  IF  Y<>0  OR  IX-1  THEN  X|-STR|(100#+Y)  :V^V|*RiaHT|(X|,2)+-a- 
1060  X"606*(X-Y)  :Y*IHT<X)  :X$-8TR|(100i+Y)  :V**V|+RIGHT|fX|.2)+-«":RETUlN 
1070  * 

1080  *  DECIMAL  TO  CDD  NN.F 

1000  VI—  -:IF  X<0  TSEN  V|— -“  .X— X 

1100  X-X+l/1200i:Y-IHY(X):V|»V|+RIGHT$(-  ■♦STR*(Y),3)+CHR|(248) 

1110  X-600i+(X-Y):Y»INT(X):X$-8TR|(1000+Y) 

1120  V|*V|+MID|(Xl,3,2)+-."+RIGHT|(X|,l)+-'-:RETURN 
1130  ‘ 

1140  ’  DCD.NMB8  TO  DECIMAL 

1150  H-0:POI  Z!«l  TO  LEN(Vl) :d-MID|(V|,Zt ,1) : IF  C|— .-THEN  IX-ZI 

1160  NEXT: IF  EW>  TEEN  X-VAL(VI) : RETURN 

1170  X-VAL(LEPT|(V| , IX) ) : SIM : IF  X<0#  TIEN  SN— 8N:X— X 

1180  VI-VI+-0000- : Y"?AL (MIDI ( V| ,  IX+ 1 , 2)) :Z-VAL(MIDS(V|, IX+3,2)) 

1190  X-8N+((Z/60#+Y)/606+X) : RETURN 
1200  * 

1309  ‘DIRECT  SOLUTION,  SPIER  EARTH -RECT  COORD.  ALL  ANGLES  MUST  BE  IN  &ADIAN8 

1310  ‘INPUT:  LATITUDE  PI,  LONGITUDE  LI.  FORWARD  AZIMUTH  A12  AND 
1320  *  DISTANCE  DD  TO  A  POINT  P2.  NOTE:  DD  IS  IN  RADIANS. 

1330  ‘OUTPUT:  LATITUDE  P2,  LONGITUDE  L2  AND  BACKWARD  AZIMUTH  A21. 

1340  P-P1:L—  Ll.GOSUB  1750:  ‘CHNG  SIGN  OP  LI  GIVES  RIGHT-HANDED  COORDS 
1360  FOR  I 1-1  TO  3:PQ81(I!)"P08ICI!) :NQRTB1(I!)"NQRTS(I!) :EASTl(I!)a>EA8T(II ) 
NEXT 

1360  COSUB  1810:CD-CQ8(DD):8D-SIN(DD) 
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1370  FOR  Il"l  TO  3:P082(I!)aP081(ll)*CD+CVSCl(2l)*8D:NEXT 

1380  L2«FNATN2(P0S2(2),P0S2(1)):P2-FNA8N(M82(3)):P»P2:L-L2:M8UB  1760 

1380  ZHZVEC(1)*EA8T(1)*<IVEC(3)*EA8T(2)+0YEC(3)*EAST(3) 

1400  T—  (e?EC(l)*M0m(l)+CVBC(2)*H0RTH(2)+<!»EC(3)*H0RTHC3)) 

1410  A2i»FNATNP(Y, X) :  L2"-L2 :  RETURN :  *  CONVERT  BACK  TO  LEFT-HANDED  OUTPUT 
1420  ‘ 

1600  'INVERSE  SOLUTION,  8PHEK  EARTH -REGT  COORD.  ALL  ANGLES  MUST  BE  IN  RADIANS 
1610  'INPUT:  LATITUDES  PI  ft  P2,  AND  LONGITUDES  LI  ft  12. 

1620  'OUTPUT:  DISTANCE  DD  TO  A  POINT  P2.  (NOTE:  0  <-  DD  <-  PI  RADIANS). 

1530  1  FORWARD  AZIMUTH  A12,  AND  BACKWARD  AZIMUTH  A21. 

1540  P“P1 : L“-L1 : GOSUB  1750:'  CHNG  SIGN  OF  LI  GIVES  RIGHT-HANDED  COORDS 
1560  FOR  I!»l  TO  3:P081(II)-P0SI(It):N0RTHl(I!)-NQ&TH(It) :EA8T1(I!)-EA8T(I0 : 
NEXT 

1680  P-P2:L— 12: GOSUB  1750:'  CHNG  SIGN  OF  L2  GIVES  RIGHT-HANDED  COORDS 
1670  FOR  1!-1  TO  3:P082a!)-P0SI(II ) :N0RTE2(I!)-NGR7H(I!) :EA812(I! )-EAST(I!) : 
NEXT 

1680  D>FNACS{P0Sl<l)*P0S2(i)+P0Sl<2)*P0S2(2)+PQ81(3)*PGS2(3)) 

1680  X-FNCXCP0S1 ( 1 ) , P081 (2) . P081 (3) . P082 ( 1 ) . P082 (2) . P082 (3) ) 

1800  Y-FNCY(POSKl) ,P081(2) ,P081(3) ,P082(1) ,P082(2) ,P082(3)) 

1810  Z-FNCZCP081 ( 1) . P081 (2) , P081 (3) , P082 ( 1 ) , P082(2) , P082(3) ) 

1820  A12MFNATNP(X*NQRTHl(l)+¥+NORTHl(2)+Z*NORTHl(3) , 

- (X*EA8T1 (1 ) +Y*EA8T1 (2) +Z*1A8T1 (3) ) ) 

1830  A21^ATNP(-(X*N0RTI2(1)+Y*N0RTH2(2)+Z*N0RTH2(3)) , 
X*EA8T2(i)+Y*EA8T2(2)+Z*EAST2(3)) 

1840  RETURN 
1860  ’ 

1700  GA-C08CA)  : 3A-SIN(A) :  T-Y*CA+Z*SA:  Z-Z*CA-Y*8A :  Y>T :  RETURN : '  X-AXI8  ROT 
1710  CA^COSCA) ;8A“8IN(A) :T*Z*CA+X*8A: X“X*CA-Z*8A:Z*T : RETURN: *  Y-AXIS  ROT 
1720  CA-C08 (A) :8A-8IN(A) :>X*CA+Y*8A:Y-Y*CA-X*8A:X-T: RETURN:*  Z-AXI8  ROT 
1730  ' 

1740  'UNIT  VECTORS:  POSITION,  NORTH  ft  EAST. 

1760  SL-8IN(L):CL-CaS(L):8P-8IN(P):CP-C08(P) 

1780  P08I(l)-CP*CL:Pa8I(2XP*8L:P08I(3)-8P 
1770  NORTH(l)— BP*CL:N0RTH(2)— SP*SL:N0RTH(3)-CP 
1780  EAflT(l)— 8L:EA8T(2)-CL:EA8T(3)-0:  RETURN 
1780  * 

1800  ‘  VECTORS  :CVEOCOUR8E  ft  GVEOGREAT  CIRCLE  NORMAL 

1810  X«0 : Y"0 : Z*1 : A"A12 : GOSUB  1700 :A-P: GOSUB  1710:A— L:G08UB  1720 

1820  CVBC1(1)«X:CVEC1(2)-Y:CVEC1(3)»Z 

1830  GVBC(1)-FNSX(P081 (1 ) , P0S1 (2) , P081 (3) , CVEC1 ( 1 ) , CVBC1 (2) , CVEC1 (3) ) 

1840  GVEC(2)»FNCY(P081 ( 1 ) , P08 1 (2) , P08 1 (3) , CVEC1 ( 1 ) , CVBC1 (2) , CVEC1 ( 3) ) 

1860  GVEC(3)-FNCZ(P08ia),P081(2),P081(3),CVECl(l),CVECi(2),CVECl(3)) 

1880  RETURN 
1870  ' 

2000  CL8: PRINT  8PC(20) ; "ALGORITHM  DEMO 

2010  PRINT: PRINT: PRINT 

2020  PRINT  SPC(16);"1)  DIRECT  SOLUTION 

2030  PRINT  8PC(15);‘2)  INVERSE  SOLUTION 

2040  PRINT  8PC(15);-3)  FIND  CPA 

2060  PRINT  SPC(15) ; *4)  SPEED  NEEDED  TO  INTERCEPT 

2060  PRINT  8PC(15) ; *5)  TIME  NEEDED  TO  INTERCEPT 

2070  PRINT: PRINT  8PC(16) ; *8)  QUIT 

2080  G08UB  8010:OVAL(C$)  :  ON  C  GOSUB  3000,4000,6000,6000,7000,8000 
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2100  * 

3000  CU :  PRINT  8PC( 15) ; -DIRECT  SOLUTION" :  PRINT :  PRINT 
3010  PRINT  3PCC10); : PRINT  "lit  LATITUDE  DD.NH8S  (-8) 

3020  INPUT  V$:<»SUB  1160:P1-X*RD 

3030  PRINT  SPC(IO);: PRINT  "1st  LONGITUDE  ODD. MUSS  (-E) 

3040  INPUT  VS:Q08UB  1160:L1»X+RD 

3060  PRINT  SPC(IO);: PRINT  "INITIAL  COURSE  DDD.NMSS 

3060  INPUT  Vt.GOSUB  1160:A12-X*RD 

3070  PRINT  8PC(10);: INPUT  "DISTANCE  (a.  mi.)  T  “,D 

3080  Dl«D*RD/80# 

3000  MO-100 

3100  DD-D1 : GQ8UB  1340: PRINT: PRINT  8PC (8) ; "SPHERICAL  EARTH  DIRECT  SOLUTION 

3110  PRINT  SPC(12);"2nd  LATITUDE  •; :X-P2/RD:G08UB  1000: PRINT  Vt 

3120  PRINT  SPC(12) ; "2nd  LONGITUDE  •; :X-L2/RD:G0SUB  1090: PRINT  VS 

3130  PRINT  8PCC12); "RACE  AZIMUTH  *; :X-A21/RD:G08UB  1000:PRINT  VS 

3140  G08UB  0000: GOTO  2000 

3160  * 

4000  CLS: PRINT  8PC (1 5) ;" INVERSE  SOLUTION": PRINT: PRINT 
4010  PRINT  SPC(IO);: PRINT  "1st  LATITUDE  DD.W88  (-8)  •; 

4020  INPUT  VS:GQ8UB  1160.P1-X 

4030  PRINT  SPC(IO); : PRINT  "1st  LONGITUDE  DDD.HM88  C~E)  ■; 

4040  INPUT  VS:GQ8UB  U60:L1-X 

4060  PRINT  SPC(IO); : PRINT  "2nd  LATITUDE  DD.MiSS  (-8)  •; 

4060  INPUT  VS:G08UB  U60:P2-X 

4070  PRINT  8PC(10); : PRINT  "2nd  LONGITUDE  DDD.MMS8  (-E)  ■; 

4080  INPUT  VS:  GO  SUB  1150:L2-X 

4000  P1-P1*RD:P2-P2*SD:L1-L1*RD:L2-L2*RD 

4100  DD-D1 : G08UB  1640 

4110  PRINT :P1INT  SPC(8) ; "SPHERICAL  INVERSE  SOLUTION 
4120  * 

4130  PRINT  8PC(12) ; "DISTANCE  «; 

4140  MO-lOO: PRINT  PHR(60#*DD/iD) ;■  a. mi. 

4160  PRINT  8PC(12) ;  "FORMED  COURSE  ■; :X-A12/RD:G08UB  1090: PRINT  VS 
4160  PRINT  8PC(12) ; "RACK  COURSE  :X-A21/RD:G0SUB  1000: PRINT  V) 

4170  G08UB  9000: GOTO  2000 
4180  F 

6000  CLS: PRINT  8PC(20) ; "FIND  CPA": PRINT: PRINT 

6010  PRINT  8PC(10);: PRINT  "1st  LATITUDE  DD.M8S  (-8)  ■; 

6020  INPUT  VS : GO SUB  U50:P1»X*RD 

5030  PRINT  8PC(10);: PRINT  "1st  LONGITUDE  DDD.MM88  (-E)  •; 

6040  INPUT  VS:GOSUB  il60:Ll-I+RD 

6060  PRINT  BPC(IO);: PRINT  "INITIAL  COURSE  DDD.NMSS  ■; 

6080  INPUT  VS:G08UB  U60:A1-X*RD 

6070  PRINT  8PC(10) INPUT  "SPEED  (knots)  T  *,31 

6080  PRINT  SPC(IQ) ; : PRINT  "2nd  LATITUDE  DD.MMS8  (-8)  ■; 

6090  INPUT  VS:G08UB  1150:P2*X*RD 

6100  PRINT  SPC(IO);: PRINT  "2nd  LONGITUDE  DDD.NMSS  (-E)  •; 

6110  INPUT  VS:G08UB  116Q:L>X*RD 

6120  PRINT  8PC(10) ; : PRINT  "INITIAL  COURSE  DDD.NMSS  •; 

6130  INPUT  VS: GO SUB  1160:A2-X*aD 

6140  PRINT  SPC(IO); : INPUT  -SPEED  (knots)  T  *,S2 

6160  Bl-fll/AE: B2-32/AE 


6160  ' 

6170  P-P1:L— Li:G08UB  1760:’  CENG  SIGN  OF  LI  GIVES  RICH* -HANDED  CDO&DS 
6180  FOR  Il-l  TO  3:na!)-PGSI(H):NOT 

5160  X*0 :  Y38© :  Z=*l :  A«Ai :  GQ3UB  1700  :A«P:  COSOS  1710:A— L:G08UB  1720 
6200  Cl(l)-X:Cl(2)*Y:Ci<3}^Z 

5210  P«P2:L"-L2:008UB  1750:'  CHNO  SIGN  OF  L2  (JIVES  RIGHT-HANDED  COORDS 
6220  FOR  I!»l  TO  3:X2(II)»P08I<I!) :NEXT 

5230  X«0 : Y"0 :  7*1 :  A“A2 :  G08UB  170O:A»P:G0SOB  1710:A— L:Q08UB  1720 
5240  C2<1)-X:C2(2)-Y:C2(3)«Z 
6250  * 

6260  X1C2"X1(1)<>C2(1)+X1<23*C2(2)+X1(3)*C2(3) 

6270  ClX2-Ci(l)*X3<l)+Cl(2)*X2(2)*Cl(3)*X2(3) 

5280  XlX2-Xl<l)*X2a)*Xl(2)*X2(2)*XlC3)*X2(3) 

6200  C1C2-C1(1)*C2(1)+C1(2)*C2(2)+C1C3)*C2(3) 

630C  BA— B1*X1C2  -  B2*C1X2 
5310  BB-  B1+C1X2  +  B2*X1C2 
6320  BC—B1*X1X2  ♦  B2*C1C2 
5330  BD-  B1*C1C2  -  B2*X1X2 
5340  * 

6350  T>i:IT!“0: *  ITERATE  VITH  NEVTQN-BAPH8QN 

5360  B1T-B1*T: B2T-B2*f : Sl-SIN(BIT) : Cl-COS(BIT) : S2-8IN(B2T) : C2-C0S(B2T) 

6370  81S2-Sl*82:ClC2-Cl*C2:81C2«81*C2:C182«Ci*82 
5380  F”BA*S182+BB*C1C2*BC*S1C2+BD*C1S2 

5300  FP— (BC*B2+BD*Bi)*81S2+(BD*B2+BC*Bl)*ClC2-»(BA+B2-BB*Bl)*8iC2- 
BS*B2-BA*B1)*C182 

6400  IT ! •IT ! +1 : COBIfF/FP : T*T-CQRI: IF  ABS (COER) <00301  THEN  5440 
6410  IF  IT! >60  THEN  PRINT  “NO  CONVERGENCE" : 8TQP 
6420  GOTO  5360 
5430  * 

5440  B1M1*T:B2T-B2*T:CB1T-C08(B1T):8B1T-SIN(B1T>:CB2T«C08(B2T):SB2T-8XN(B2T) 
6460  FOR  I!-l  TO  3:PQ81(I!)-Xl(I!)*CBlT+Cl(I!)*8BiT 
5460  P082(Ii)-X2(I!)*CB2T+C2(X!)*SB2T:NEXT  I! 

6470  P1"FNA8N(P081 (3)} : LI— FNATN2(P0S1 (2) . P08i ( 1) ) 

6480  P2-FNA8N(PC82(33) :L2— FNATN2(P082(2) ,P0S2(1)) 

5400  G080B  1540 

5600  X-T:G080B  1010: PRINT: PRINT  8PC(10);"TINE  TO  CPA  ■  ";Vt 

5610  MO»iOO#: PRINT  8PC(10) ;"DI8TANCE  AT  CPA  ■  »;FNR(60#*DD/RD); “  n.mL. 

5620  PRINT  8PC(10) ; “BEARING  AT  CPA  -  “ ; : X-A12/MJ : G08UB  1000: PRINT  V| 

6530  PRINT  SPC(IO) ; "NO.  ITERATIONS  -  ";IT1 
5540  TCPA“T : GO BUB  0000 
6650  * 

6560  CL8: PRINT  8PC(22) ; "FIND  CPA": PRINT 

6670  PRINT  »  TINE  LAT  1  LONG  1  DISTANCE  BEARING(l->2)* 

6580  DT-TCPA/6# :T^):FOR  Tl-i  TO  13:B1T-B1*T:B2T-B2*T 
5600  FOR  Il-l  TO  3:PaSl(I!)-Xl(I!)*C08(BlT)+Ci(I!)*SIN(BlT) 

5600  P082(I!)"X2(II)*C0S(B2T)*C2(I!>*SIN(B2T):NEXT  I! 

5610  P1-FNA8N(P081(3)):L1— FNATN2(P081(2) ,P081(1)) 

6620  P2-FNA8N(PCS2 (3) ) : L2— FNATN2(P082 (2) , P0S2 ( 1 ) ) 

5630  G08UE  1640 

6640  X-T:GQ8UB  1010:PRINT  V$; 

5650  LOCATE  C8RLIN, 12:X-P1/RD:008UB  1000: PRINT  V$; 

5660  LOCATE  C8RLIN,23:X»L1/RD:G0SUB  1000:PRINT  V$; 

5670  LOCATE  CSBLIN , 37 : PRINT  FNR(60#*DD/RD) ; 


5680  LOCATE  C8SU.IN , 52 : X-A12/RD : 009U9  1080: PRINT  VI 
3680  T-TtOT:NEXT  T! 

5700  00808  0000:0070  2000 
5710  * 

6000  CL8: PRINT  8PC(10); "SPEED  NEEDED  TO  INTERCEPT  (1->2)":PRINT:PRINT 
6010  CLNX-0:008UB  6610:*  GET  INPUT 

6020  CLNt- 10: LOCATE  CLNl,l:FOR  11-1  TO  11: PRINT  8PC(70) :NE3CT: *  CLEAR  SCREEN 
6030  LOCATE  CLNl,ll:PRZNT  "TINE  TO  INTERCEPT  (SECONDS)  INPUT  TNI 
6040  TNI-TMI/3600# :  TJMMI :  P1-P18 :  L1-L1S :  P2-P28 :  L2-12S :  A2-A2S 
6060  * 

6060  *  COMPUTE  SPEED 

6070  P-P18 : L--L18 : G08UB  1760:*  CHNG  SIGN  OF  LI  GIVES  RIGHT-BANDED  COORDS 
6080  FUR  11-1  TO  3:X1(I!)-P08I(I!) :NEXT 

6000  P-P2S :  L— L28 :  GOSUB  1750:*  CENG  SIGN  OF  L3  GIVES  RIGHT-BANDED  COORD8 
6100  FOR  11-1  TO  3:X2(I!)-P08I(I!):NEXT 

6110  X-0:T*«0:  Z-i :  A-A2 : GCfiUB  1700:A»P:G0SU8  1710:A— L:008UB  1720 

6120  C2(1)-X:C2(2)-Y:C2(3)«Z 

6130  B2T-32*TM:CB2T-C08(B2T):SB2>8IN(B2T):G8»O# 

6140  FOR  Il-l  TO  3:P0S2(I1)-X2(I!)*CB2TtC2(II)*8B2T 

6160  C3*G8+X1(II)*P082(II) :NEXT  II 

6160  8-FNAC8(C8):8PD-6*AE/(TN-EP8*(TN-0)) 

6170  * 

6180  *  GET  IKVER8E  80LN 

6100  P2-FNA8N(P082(3)):L2— PNATN2(P082(2),PQS2(1)):G08UB  1540 
6200  * 

6210  NO- 10: LOCATE  CLN1*2. 11: PRINT  "SPEED  REQUIRED  -  ";FNR(8PD);a  knots" 

6220  308UB  6810: *  PRINT  OUT  BEARING,  RANGE,  LAT  A  LONG 
6230  LOCATE  CLNl*8, 15: PRINT  "1)  CHANGE  TIME  OF  INTERCEPT" 

6240  LOCATE  CUflt+O, 15: PRINT  "2)  NEW  PROBLEM" 

6260  LOCATE  CLNltlO, 15:PRINT  "3)  MASTER  MENU" 

6260  0Q8UB  0010:OVAL(C|):0N  C  GOTO  6020,6000.2000 
6270  GOTO  6260 
6280  * 

6600  *  INPUT  ROUTINE 

6610  LOCATE  CLNXtS, 11: PRINT  "lit  LATITUDE  2D.NM88  (-8) 

6620  INPUT  Y|:G08UB  1150:P1S-X*RD 

6630  LOCATE  CLNX+4, 11: PRINT  "lat  LONGITUDE  DDD.MM88  (-E)  »; 

6640  INPUT  V$:Q08UB  1150:L18-X*RD 

6660  LOCATE  CLNX+6, 11: PRINT  "2nd  LATITUDE  DD.MM88  (-8)  »; 

6660  INPUT  7|:G08UB  1150:P2S»X*RD 

6670  LOCATE  CLNX+6, 11: PRINT  "2nd  LONGITUDE  DDD.NM88  (-E) 

6680  INPUT  7|:G08UB  1160:L28-X*RD 

0600  LOCATE  CLNXt7, 11: PRINT  "2nd  COURSE  DDD.MM8S  ■; 

6600  INPUT  V| : 00 SUE  U60:A2S»X*RD 

6610  LOCATE  CLNlt8.il: INPUT  "2nd  SPEED  (knots)  7  ",S2 

6620  B2-82/AE: RETURN 

6630  9 

6800  '  OUTPUT  BEARING,  RANIS,  LAT  A  LONG 

6810  LOCATE  CLNlt3, 11: PRINT  "BEARING  TO  INTERCEPT  -  "; 

920  X-A12/RD : GO HUB  1000: PRINT  V| 

6830  LOCATE  CLNlt4, 11: PRINT  "RANGE  TO  INTERCEPT  -  ■ ;FNA(00#*3D/aD) ; “  a.ni." 
6840  LOCATE  CLNl+6, 11:  PRINT  "LATITUDE  OT  INTERCEPT  - 
6860  X-P2/RD : G08UB  1000: PRINT  Y| 


6860  LOCATE  CLNt+6. 11: PRINT  "LONGITUDE  OP  INTERCEPT  «  *; 

6870  X-L2/RD:G08UB  1000:  PUNT  VI 
6880  RETURN 
6800  * 

70T0  CL8: PRINT  SPC(10);"TIME  NEEDED  TO  INTERCEPT  (l->2)": PRINT: PRINT 
7010  CLN%-0:008UB  6610:*  (SET  INPUT 
7020  * 

7030  *  FIND  Vmin  AND  Tnin  r»l. 

7040  *  Ceaputs  «xc  distance  8 

7060  P-P1S:L»- L18:G0SUB  1760:*  CHNG  SIGN  OF  LI  GIVES  RIGHT-BANDED  C00RD8 
7060  FOR  I!-l  TO  3  X1(1! )»P06I(I!)  :NEXT 

7070  P-P28 : L— L28 : G08DB  176C:*  CHNG  SIGN  OF  U  GIVES  RIGHT-HANDED  COORDS 
7080  FOR  Il-l  TO  3:X2(I!)"P0BI(I!) :NEXT 

7000  X-0:T-0:Z-1:A-A2S:G0SUB  1700:A«P:G0BUB  1710:A— L:GOSUB  1720 
7100  C2(1)-X:C2(2)-Y:C2(3)"Z 
7110  * 

7120  *  INITIALIZE 

7130  X1X2-X1(1)*X2(1)+X1(2)*X2(2)+X1(3)*X2(3) 

7140  XlC2-Xl(l)*C2(i)+Xl(2)*C2(2)*Xl(3)*C2<3) 

7150  * 

7160  ’  BEGIN  ITERATION 

7170  S-PKAC8(X1X2) :Ta4*AE/S2:IT!-l 

7180  B2T-B2*T : C82T-C08CB2T) : 8B2T-8IN(B2T) 

7100  CS»XlX2*CB2T*XlC2*aB2T: S-FNACS(CS) : SS-fllN(S) 

7200  D8D>(XlX2*8B2T-XlC2*CB2T)*B2/88 
7210  r»T*DSDT-8 

7220  FP-T*(B2*B2*(XlX2*CB2T+XlC2*8B2T)-C8*D8DT^D8DT)/88 

7230  IT ! -IT ! * 1 : CORl-F/rP : T-T-CORR : IF  AB8 (COIR) <.00001  THEN  7270 

7240  IF  IT! >60  THEN  PRINT  "NO  CONVERGENCE' : STOP 

7260  GOTO  7180 

7260  * 

7270  TM8-T:VMIN*S*AE/T 
7280  LOCATE  CLNttlO.il: M0-10 

7200  PRINT  "MINIMUM  SPEED  REQUIRED  TO  INTERCEPT  -  " ;  FNR(VMIN) ;  *  knots" 

7300  LOCATE  CLNt+il.ll:X«TNS:G08UB  1010 

7310  PRINT  "TIME  REQ’L  TO  INTERCEPT  AT  MIN  8PEED  -  ";Vf 

7320  * 

7330  CLNtFlS: LOCATE  CLNt.l:FOR  I!-l  TO  11: PRINT  SPC(70)  :NEXT:  *  CLEAR  SCREEN 
7340  LOCATE  CLNl, 11 : PRINT  "INTERCEPTOR  SPEED  (knots)  *; : INPUT  8PD 
7360  IF  8PD>-VJCDl  THEN  7300 

7360  LOCATE  CLNXt2, 11: PRINT  "SPEED  TOO  LOW.  CANNOT  INTERCEPT" 

7370  GOSUB  0000  GOTO  7330 
7380  * 

7300  B1-8PD/AE : T-TM8/8 :  T-.l  :IT!-1 
7400  B2T-82*T:C82T-Cl^(B7T):8B2T-8IN(B2T) 

7410  C3-X1X2*CB2T+X1C2*8B2T : 8-7NAC8 (CS) : S8-8IN(3) 

7420  D8DT-(XlX2*8B2T-XiC2*CB2T)*B2/88 
7430  F-8/T-B1 :FP*(DSBT-8/T)/T 

7440  IT ! -IT I + 1 : CORR-F/FP : T-T-CORR : IF  AB8 (CORE) <.00001  THEN  7600 

7460  IF  IT! >30  THEN  PRINT  "NO  CONVERGENCE" : STOP 

7460  IF  AB8 (COIR) <1000000000#  THEN  7400 

7470  LOCATE  CLNX+2, 11: PRINT  "SPEED  TOO  HIGH,  NO  CONVERGENCE" 

7480  LOCATE  CLNt+4: GOSUB  0000: GOTO  7330 
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M .■"  *f.  **  1*  =  ^  *’-;•,  »fj  »  P<  \  »”■-  *  -*  «.n  k.'v«..i  »  ^  m-  ' 


**n. 


7490  ' 

7500  X-TGOSUB  1010 

7S10  LOCATE  CLNE+2 ,11: PRINT  "TIME  REQUIRED  -  ";V$ 

7520  * 

7630  *  GET  I5YEX3E  SQLN 

7540  POS  11*1  TO  3:P0S2(I!)-X2(I!)*CB2T+C2(II)*S32T:NEn  I! 

7660  P1»P18:L1HL1S:P2"FKA£N(PQ82(3)) :L2*-FNATN2(P082(2) ,P082(1)) :<S0SUB  1640 
7560  ’ 

7570  00803  0810:'  PRINT  OUT  BEARING,  RANGE,  LAT  A  LONG 
7580  LOCATE  CLNX+8, 15: PRINT  "1)  CHANGE  INTERCEPTOR  SPEED* 

7690  LOCATE  CLNl+9, 15: PRINT  *2)  NEW  PROBLEM* 

7800  LOCATE  CLNX+10, 15: PRINT  *3)  MASTER  MENU* 

7610  60 SUB  9010 : 07AL(C|) : ON  C  GOTO  7330,7000,2000 
7620  GOTO  7610 
7630  * 

8000  CL8:END 
8010  * 

9000  PRINT :  PRINT  8PC(10) ;  "PRESS  ANY  KEY  TO  CONTINUE 
9010  FOR  I!«l  TO  9 : C$«INIET$ : NEXT 
9020  C*»INRET*:XF  C$»""  THEN  9020 
9030  RETORN 
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